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1. INTRODUCTION 

It has been widely recognized that modelling errors can lead 
to sensitivity problems and even divergence of Kalman-Bucy filter. 

In cases where the nominal plant parameters used in the filter design 
are different from the actual plant parameters, the uncompensated 
mismatched steady state Kalman-Bucy filter exhibits bias errors, Athens [1] 
discussed this problem, and presented a brief survey of the various 
schemes to reduce filter sensitivity. In particular Ref- [1] 
introduced the continuous time compensated Kalman filter, a sub- 
optimal state estimator which can be used to eliminate steady state 
bias errors when it is used in conjunction with the mismatched 
steady state (asymptotic) time-invariant Kalman-Bucy filter. The ap- 
proach used relies on the utilization of the residual (innovations) 
process of the mismatched filter to estimate, via a Kalman-Bucy 
filter, the state estimation errors and siabsequent improvements of 
the state estimate. The compensated Kalman filter augments the mis- 
matched steady state Kalman-Bucy filter by the introduction of ad- 
ditional dynamics and feedforward integral compensation channels . 
Satisfactory results of this compensated Kalman filter in a practical 
design have been reported by Michael and Farrar [2] , where it was 
applied to the estimation and control of critical gas turbine engine 
varicibles. 

This note follows the same philosophy and development as [1] , 
for the discrete time case. In section 2^ we give definitions and 
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and assTomptions as well as the definition of the nominal mismatched steady 
state Kalman-Bucy filter. Section 3 analyzes the errors due to mismatching, 
Section 4 contains the main contribution which deals with the development 
of the compensated filter structure and equations. Section 5 contains the 
discussion of the results. 

The elimination of bias errors is accomplished by having accumulators 
(the cLnalog of integrators) acting upon the residuals. Thus if persistent 
bias errors exist due to model mismatching, the accumulators provide the 
necessary corrections so that the bias errors are removed from the estimates 
in steady state. 

The approach selected was dictated by issues of simplicity of design, 
namely the use of constant gains in the estimator realization, and the avoid- 
cuice of real time parameter estimation, which requires extensive real time 
calculations. All calculations of the constant filter gains cain be carried 
out off-line. 
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2. DEFINITIONS AND ASSUMPTIONS 

Only modelling errors in plant parameters will be considered 
throughout this paper. We believe that this is often the case in 
practice. When there are errors in the statistical parameters of the 
underlying random processes, a different approach is required and the 
results are more complicated. 

2.1 ActueLL Plant Description 

We assume that the actual plant is an n-th order linear time- 
invariant, stochastic dyneunical system with state vector x(t)£ 
constant input vector ii e R™ and noisy measurement vector z^(t)e R^ 
described by 


(State Equation) x(t+l) = A x(t) + u + ^(t) (1) 

(Measiarement Equation) z^(t) = JC(t) + £^(t) (2) 

where A, B_, C_ are respectively nxn, nxm, rxn constant matrices-. 

The plant noise ^(t) and the measurement noise ^(t) are white 
Gaussian stationary processes with the following statistics, which 
are assumed to be known to the designer. 


E(C(t))= 0^ 

b{^( 8)£' (t)}= 56 

E(9_(t))= 0 
E{£(s)£'(t)} 


for all t 
for all s 
for all t 


/t 


(3) 

(4) 

(5) 

($) 


for all s,t 



where 6 ^ denotes the Kronecker delta, and H, the plant noise 
intensity matrix, is a constant nxn positive semi-definite SYinmetric 
matrix, vdiile 6, the measurement noise intensity matrix is a 
constant rxr positive definite symmetric matrix. Moreover, ^(t) 
and ^(s) are assumed to be uncorrelated for all s, t, i.e. 

E{£(t)£'(s)} = 0 (7) 

It is further assximed that (with t^ ^ 

E{x(to)}=0 (8) 


2.2 Model Description 

The actual plant dynamics are defined by the values of the 
three constant matrices ^ in equations (1) and ( 2 ) , and 

the noise statistics defined in equations (3) -(8). We shall assume 

that the actual values of A^ ^ and C are not known exactly to the 

designer. Rather, nominal values A , B , C are available to the 

— n — n — n 

designer in addition to perfect knowledge of the noise statistics, and 
the value of the constant input vector u. Thus as far as the designer 
is concerned, the model is given by 

x(t+l) = A x(t) + B u + ?(t) 

— — — 


( 9 ) 


II 
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For later development, define the following parameter error 
matrices ; 


aa 

A 



ss 

A - 

A 




— n 


II i> 

B - 

B 




-n 

Ac 

A 




C - 

c 

— n 


( 11 ) 

( 12 ) 

(13) 


2.3 Ftirther Assxanptions 

We limit the discussions to constant gain filters, as in [1], 
since they represent one of the most practical uses of Kalman- 
Bucy filters from the application viewpoint, and they can readily 
lead into steady state error and stability analysis. The following 
assumptions are necessary for the derivation of the results. 

1. [A,B] and [A ,B ] are controllable pairs. 

— — — T1 “T1 

2. [A,C] and [A ,C ] are observable pairs, 

1/2 - 1/2 

3. [A,c ] and [A ,t ] are controllable pairs. 

— 

4. Both A and A are strictly stable matrices, i»e 

all of their eigenvalues lie within the unit 

circle. This also implies that (A-I) ^ and (A - I) exist. 

— “ — n 

These assumptions are indeed necessary for the rigorous development 
of a unique, stable, steady state Kalman-Bucy filter. 
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2.4 Defini-tion of the Nominal Mismatched Steady-State Kalman 
Bucy Filter (NMSSKBF) 

Let us suppose that the designer constructs the NMSSKBF on the 
basis of the nominal parameter values available to him and the as- 
sumed knovm statistical parameters. Then the state estimate of ^Ct). , 
X (t)e R f generated by such a filter, is given by the following 


misma tched filter dynamics. 


X Ct+1 t) = A X (t) + B u 
— n — n— n — n— 


X Ct+1) = ^ (t+1 t) + G r Ct+1) , X Ct ) = 0 

— r> — n *~Tl“n — n tJ — 


r Cti = zCt) - C X Ct t-ll 
— n — -n— n 


where G is a constant nxr filter gain matrix given by 


a4al 

a4b). 

aS]L 


G =2 C' CQ + C 2 C')“^ 

-^1 —n — n — -Ti -Ti — n 


(16) 


and ^ is the nxn constant, symmetric, positive definite solution 
of the algebraic matrix Riccati equation [3] 


A 2 A' - A 2 C (C 2 C + 0)"^C 2 A' + H = 2 
-TWi— n — n—n-n — — rr-n— n — — n 


(17) 


The block diagram of the NMSSKBF is shovm in Figure 1* 

The existence of ^ ^ guaranteed by our assumptions. 

Also it is well known that the closed-loop filter matrix 


[A -AGC] = [A - a 2C'C0 + C2C ) ~^C ] 
— n — n-n— n -n — - - ___ 


(18) 


is a strictly stable matrix. 




Nominal 

Measuramant Rasiduai 



Figure 1: Discrete Time Nominal Mismatched Steady State Kalnan^Bucy Filter 
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3* ERRORS DUE TO MISMATCHING 

If the NMSSKBF of Figure 1 is used without further compensation, 
severe inaccuracies arise due to the fact that the nominal plant 
matrices A , B , C are used rather than the actual (but unknown) 

"H 

matrices A, C^. Uiese effects are particularly bothersome because 
bias errors in the estimates exist. It is instructive to isolate 
these errors, because the structure of the equation suggests that 
compensation techniques Ccin be used. 


3.1 Estimation Errors and their Dynamics 

Define the state estimation error ^(t) induced by the 
NMSSKBF by 


X (t) = x(t) - X (t|t-l) 


From equations (1) , (2) , (14) , (15) , and (19 ) , one can readily 
deduce that the state estimate error x (t) satisfies the stochastic 
difference equation 


X (t+1) = A x(t) + B u + ^(t> - (A X (t) + B u) (20) 
-n ^ — n— n — n— 


Rearranging, one obtains 
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X (t+1) 



+ AB u 


( 21 ) 


3,2 Mean State Estimation Error 

Equation :C21) readily allows one to deduce the effects of model 
mismatching upon the estimation errors; bias effects are introduced. 
To compute these ^ one simply takes expected values in equation (21) • 
We remark that the expectations are not conditional ones, since the 
filter structure has been fixed. Thus 


E{2 (t+l)} = [A - A G C ]E{2 (t)} 
-n — n — n— n-n -n 


-A G Ac E{x(t) } + AB. U 
— n— n — — 

But from equation (1) , 


( 22 ) 



Thus, if some or all of AA , Ab , and ^ are non-zero, then one can 
readily conclude from (22) that bias errors exist. Note that the 
effect of the constant input u accentuates these errors, even for 


stable system. From equations C22) and C24) 
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t-t 

E{5 (t)} = [A -A G c ] °E{5(t )} 

— n ^ 1 ' n n o 


(25) 


+ S [A-A G C ]^”®{[AA-AG AC] [ A®"'^B] +Ab}u 


s=t 


T=t, 


Noting that, in view of equations ( 8 ) and (14) , 

e{x (t )} = E{x(t-)} - e{$ (t )} = 0 
— n 0 — o ““ 0 — 

equation (25) becomes 

t 


(26) 


E{x (t)} = tA -A G C.]^“®{[AA-A G_AC] [ S A®“'^B]+Ab}u 
—11 “II 11 n n — -Ti— n x— 4 - “ " 


(27) 


This is in general non-vanishing, and cannot be evaluated since A, B_, C^, 
Aa, AB, Ac are not known exactly. In particular, as t gets large, the 
mean steady state estimation errors are approached. 


lim E{x(t) } = - [A-I] ^ ^ u 
t7« 

lim E{x (t)} = [A -^G C - I]"^{[AA-A G AC] [A-I] "^B-Ab}u 

~n^— n ~ — n W' — 

t7® 


(28) 

(29) 


Both of these are non-zero. Therefore, in the mismatched case, there 
exists a non-zero mean steady-state estimation error. Again, due to 
incomplete information, one cannot compute this mean steady-state 
estimate error so as to add it to the NMSSKBF estimate x (t) to cirri ve 
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at unbiased estimates. 

3.3 Discussion 

The cdiove development indicates that the NMSSKBF should not be 
used without fincther modification. It necessitates the vise of com- 
pensation by a suboptimal estimator, because the truly optimal filter 
(that estimates the unknown elements of A, ^ and C) is an infinite 
dimensioned, one [3] . The degree of suboptimality has to be related 
to the extra dynamics that are required to improve the performance 
of the nominal mismatched Kalman-Bucy filter. 

The next section presents a compensation technique, which is 
similar to [1] . The central idea is that it augments the NMSSKBF 
by additional filter dynamics and tries to extract further informa- 
tion from the residual (innovation) processes. It has the merits 
that all gains can be pre-computed, and it avoids the complexity of 
non-linear estimation (or the extended Kalman filter algorithm) which 
is not always guaranteed to work properly [3] . Moreover, it compen- 
sates the biased mean steady state estimate error without sacrificing 
the accuracy of the state estimate, i.e. increase of RMS errors, which is 
very often the case when other techniques are used, e.g. , increased 
artifical plant noise covariance matrix I4J , 
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4. TWTC DEVELOPMENT OF 1HE DYNAMIC FILTER COMPENSATOR 

First recall the dynamic equations of the state 

estimation error x (t) , and the residual process r (t) (equations 
— n n 

(21), (15)). 


X (t+1) = [A -A G C ]x (t) + C(t)-A G0(t) + AA x(t)-A G AC x(t) 
-n — n -n- n -n -n — — n— — — -n— n— — 


+ AB u 


(30) 


r (t) = z(t) - C X Ct t-1) 
-n — -n -n ' 


(31) 


Using equations (1),(2) and (19), equation (31) can be written as 


r (t) = C X (t) + Ac x(t) + 9(t) (32) 

— n — n — n 

Note that the residual process is linear in the state estimation 

error x (t) . It is reasonable to attempt using equation (32) as a 
— n 

**measxxrement equation” to obtain an estimate of ^(t)/ the state 
estimation error. However, the existence of the unknown matrices, Aa , 

AB and ^ in equations (30) and (32) prohibits us from solving this as 
a linear estimation problem. Thus certain approximations have to be made. 
In what follows, it is shown how one can form such a linear estima- 
tion problem, by making approximations with, reasonable physical inter- 


pretation. 
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4.1 Philosophy 

Define the time sequences w(t)e and v(t)e as 
follows ; 


w(t) = M x(t) + ^ u 
v(t) = ^ x(t) 

Thus equations (30) and (32) reduce to 

X (t+1) = [A -A G C ]x (t) + w(t)-A G v(t) 
— n — n — n n — n "-n ” — n — n — 

r (t) = C X (t) + v(t) + 6(t) 

— n — n 


(33) 

(34) 


+ 


£(t)-A G0(t) 

(35) 


(36) 


Now it is apparent that equations (35) and (36) form a linear esti- 
mation problem^ with correlated plant and measurement noise ^ provided 
that w(t) and v(t) satisfy linear equations. So the next step is to 
develop simple linear equations for w(t) and v(t) . If one is pri- 
marily interested in the development of a steady-state constant gain 
filter, one can proceed as follows. 

From equations (28) and (33) , we can deduce that 

lim E{w(t) } = [ AB + AA(I-A) ^ = unknown constant (37) 

trx» 

Also 

w(t+l) - w(t) = M[(A-^)x(t) +Bu] + AAg( t) 


(38) 
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Equation. (37) implies that w(t) must have a nonzero (but unknown) 
mean steady state, while equation (38) indicates that it must contain 
a zero mean driving noise term. Both of these objectives can be 
satisfied if one selects the dynamics of w(.t) to be of the form 

w(t+l) - w(t) = ]^(t) ; w(tQ) ^ 0_ (39) 

where ][^(t) is a zero mean, white, Gaussian stationary process, i.e. 


E{x(t) } = 0 

(40) 

E{Y(t)Y'(T)} = 

(41) 

r = r* >0 

(42) 


Similarly, for v(t) , from equations (28) and (34), one can see that 

lim E{T?(t) } ■ - Ac (A-I) II = unknown constant (43) 

t-Ka “* 

and 

v(t+l) - v(t) =AC[ (A-I)x(t) + B u] + ^ ^(t) (44) 

This leads ua to select the dynamics of v(t) by the equation 

v(t+l) - v(t) = ^(t) ; v(t^) ^ £ (45) 

where ^(t) is a white, Gaussian, stationary noise process with 


statistics 
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E{X(t)}«0 (46) 

E{X(t)X'(T)} = A6t^ (47) 

A * A ' 

We remark that If ^ is known (or can be estimated on the basis 
of physical considerations) dne should select 

XCt) « M £(t) (48) 

and set 

r_ a ^ (49) 

Similarly, if ^ is known (or can be estimated) one should select 

Mt) = ^ 5(t) (50) 

and set 

A = ^ E (51) 

In view of equations (48) and (50), or physical reasoning, 
one should consider y(t) and ^(t) as two correlated processes, 

i.e. 


E{x(t) X' (X) } = (52) 

Indeed if both Aft and Ac are known or can be estimated, one should set 

Q , = AA H AC 


(53) 
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Also ^(t) should be correlated with x(t ) , and ^(t) . Let 


E{C(t)Y'(T)} = 
E{£(t)V(T)} = 

In partictilar 



AA' 


if Aa is known (or can be estimated ) , and 


(54) 

(55) 


(56) 



(57) 


if Ac is known (or can be estimated) . 

The above development allows one, by making certain 
proxiaiations , to replace equations (30) and (32) by a linear estimation 
problem with plant dyn ami csl given by 


X (t+l)l 

— n 


"a -A G C I -A G “ 

— n — n— n— n — -rt-n 


1 


r I 0 0 -A G ' 

— — — — n— n 

w(t+l) 

= 

£ I £ 


w(t) 

+ 

£ i £ £ 

_v(t+l) - 


— 1 

Hi 

ol 

o| 

1 


-V(t) - 


ol 

Hi 

o| 

o| 
1 


(fe(t+l) 


F 


i(t) 


D 


i(t) 

X(t) 

X(t) 

£(t) 

]jj.(t) 


( 58 ) 


and measurement equation given by 
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r (t) = [C 0 1] 

— n “H — 


X (t) 


+ 6 (t) 


Thus a Kalman-Bucy filter can be designed to generate estimates of 
^(t) , ^(.t) , and v(t) , denoted respectively by a^(t) , w(t) , and 

v(t) , based on past measurements of ^ T ^ t. 

Recalling that (see equation (19)) 


x(t) = X (t|t-l) + X (t) (60) 

— — n 

it is clear that an improved predicted estiiuata xCt[t-l), and updated 
estimate xCt) of xCt) can he constructed hy 


xCt t-1) = X Ct t-1) + X Ct t^l) 
— ' “-n ‘ — n ‘ 

xCtl == X (_t|t-l) + X C±). 

-- -n ' —n 


t61al 


C51h) 


4.2 D etails of Constructing the Compensated Filter 

/s. 

Using a steady state Kalman-Bucy filter, the estimates f 

w(t) and v(t) are generated via the following equations 


(t+l|t) = [A -A G C Jx Ct) + wCt) - A G vCt) -A G 0 (0 + HSHL’ I 


[r tt) - C X (tl t-l)-v(t-l) ] (62a) 


X (t+1) = X (t+1 t) + L [r (t+1) - C X (t+1 t) - v(t)] (62b) 

~n — n —X — n — n— n — 


w(t+l) = w{t) + L [r (t+1) - C X (t+l|t) - v(t)] 

“H n n ‘ 


2.(t+l) = v(t) + L [r (t+1) - C X (t+1 t) - 0(t)] 
“V — n ■ n- n — 
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where ^ are respectively nxr, nxr and rxr constant 

matrices (steady state filter gains ) , which will be defined below. 
The initial conditions that one might use are 


o 

il 

o 

(65) 

/N 

wct^) = 0 

(66) 


V(t^) = 0 

(67) 


They are chosen because one can view Aa , AB , Ac as random 
matrices with zero means ^ the nominal values A , B , C used by 
the designer represent the ^ priori mean values of A, ^ and C, 
respectively* 

Now referring back to equations C58) and (39)., define for 
notational convenience the matrices 



-<y -CX ~ 


^2 


%V - - 


qj. A 0 

-CX -rx - 


( 68 ) 



0 


e 


( 69 ) 
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Then M plays the role of the composite plant white noise (]J>(t)) 
intensity matrix, and N yields the correlation between the composite 
plant white noise j/j.(t) and the measurement white noise ^(t) . 

Let S denote the steady state predicted error covariance matrix 
associated with the estimation problem defined by equations C58), and 
(59) . Then ^ is a symmetric at least semi-positive definite matrix. 
In addition, it is the positive semi-definite matrix solution to the 
algebraic Riccati equation Ctake e.g. the dual in [5], 


S = [P - D N £'^H1 [£ - £ H ' (0 + H S_ H ' ) £1 tF " D N ©“^] ' 


+ D[M - N ID' 


(70) 


One can then compute the filter gain matrices L / L and L that appear in 


(62) -(64) by 


L 

-sc 

L 

-w 


= S H' (0 + H S H’) 


-1 



(71) 


4,3 Simplification 

The realization of Section 4.2 can he considerably simplified. 
Define the compensated residual process £(Jb) by 
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r(t) = 2 (t) - C x(t[t-l) - v(t-l) 

— — — 

From eauation (61) we deduce that 

r(t) == z(t) - C X Ct|t-1) - C X Ctlt-ll ^ vCt-li 
^ -n-n ‘ —n— n * — 

Then from equation (15) , this becomes 

r(t) = r (t) - C X (tlt-n - ❖tt-ll 

— — n — n— n ' — 

Equations (61) , (62) , (14) and (74) yield 

x(t+llt) = X (t+l|t) + X (t+l|t) 

— ' -n ' — n ' 


-n 


= A X (t|t-l) + B u + A G r (t) 

ry ■ ■ -n- ri" 'T*> 


+ (A -A G C )x (t) + w(t) -AG v(t) 
— n -II n - n — n — -n-n— 

-AG 0(0 + H S H')~^r(t) 

— n-Ti — 


= A x(t) + B u + w(t) 
-n— -Ti“ — 


+ [(AG - AGCL --AGL)-AG 0(0 + HSH*) 
n ~n— n—n— X -in—n'-v’ — n— n 


From, equation (71) , it is easy to see that 
CL + L = HSH’ (0 + H S 

— n— X —V — 

After a little algebra, it can be shown that the last term in 
vanishes for all t. That is, equation (75) reduces to 

x(t+llt) = A x(t) + B u + w(t) 

— ‘ -n— -n— — 

Thus the compensated state estimate x(t+l) is given by 

/N. 

x(t+l) = X (t+llt) + X (t+1) 

— — n ' — n 

= X (t+1 it) + X (t+llt) + L r(t+l) 

— n ' — n — X— 

= X (t+1 It) + L r(t+l) 

— ' — X— 

In addition, equations (63) and (64) become 
w(t+l) = ^(t) + L £(t+l) 


(72) 


(73) 


(74) 


(75) 


^]r(t) 


equation (75) 


(76a) 


(76b) 


(76e) 


( 77 ) 
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v(t+l) = v(t) -i- r(t+l) (78) 

Figure 2 shov/s the realization of equations (76) to (78) . From 
this representation, one can deduce simpler computational procedures for 
the evaluation of the compensated Kalman filter gain matrices L^, 

To be specific, we can reduce the computations of the augmented matrices 
F, D, H, M, N (equations (58), (59), (68>, (69)) and the matrix solution 

^ in the algebraic Riccati equation (70) , and the subsequent evaluation 

of the matrices L , L , and L by equation (71) . After some algebraic 
—X ~v 

manipulations with equations (58), (59), (68) -(71) and (17), one obtains 
the follov/ing: 


F 


D N 


0 



fSn 


0 


L £ 

I 0 



0 0 1 


D[M-N 0~^N']D‘ 


llll 

%Y 

-?Y 

-iY 

r 

a , 
-rX 


%x 

A 


( 79 ) 




Figure 2 5 Discrete Time Compensated Kalman Filter 
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and equations (70 ) , (71) become 

£ = [£ - £ H' (0 + H ^ H')”^ H £1F| + 1^ 


( 80 ) 



a- S H.' (.0 + a S H' ) 


(81) 


4-4 Discussion 

The structure of the discrete- time compensated Kalman filter, 
illustrated in Figure 2 , has certain appealing physical aspects. The 
major structural difference between the uncompensated Kalman filter 
of Figure 1 and of the compensated one of Figure 2, hinges upon the 
addition of distinct accumulator loops driven, through appropriate 
gains, by the compensated residual vector £Ct+l) . Note that an 
accumulator is the discrete time analog of an integrator in the continuous 
time case. In the absence of any accumulators, the residual vector of the 
the uncompensated Kalman filter would exhibit bias errors. In the com-- 
pensated filter these residual bias errors are accumulated (integrated! 
with appropriate weightings (the gain matrices and in Figure 21 
in two different ways. The accumulator that generates the sequence 
w(t) corrects for bias errors in the predict cycle, to compensate for 
the errors modelled by the matrices Aa and Ab. This makes sense, because 
w(t) was defined by Eq. (33) in terms of M and Ab . The accumulator 
that generates the sequence v(t) corrects for bias errors in the 
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residiials due to modelling errors AC in the measurement equation; 
if Ac = the accumulator channel that generates vCt) would be absent. 

One can then think of wCt) as being a crude estimate of constant 
but unknown disturbances that are additive to the state equations, and 
of v(t) as a crude estimate of constant but unknown bias errors in the 
measurement equation. 

The improved estimate ^(t+1) generated by the compensated Kalman 

filter (Figure 2) is still instantanoxisly influenced by the compensated 

instantaneous residual r_(t+l) through the feedforward gain The 

nominal dynamics A , B , C are still being utilized and bias corrections 
“H — n “n 

via w(t) influence the predicted compensated estimate $Ct+l|t) and 
hence the residual. 

Obviously the transient perfoonnance of the estimation errors of the 
coit^ensated Kalman filter would hinge upon the numerical values of the 
three gain matrices L , L , and L . These in time would not only de- 

— X ^ — 7 

pend upon the nominal parameters, but upon the way the intensity matrices 
of the white noise sequences Yft) - see eq. (39) - and _^(t) - see eq. 

(45) - are selected. It is the authors^ opinion that the suggested 
guidelines for the covariance selection are reasonable, since for most 
practical problems the designer has a reasonable idea of the worst 
possible modelling errors, exhibited in Aa , AB , and Ac , from the nominal 
parameters. It is important to stress that the white noise intensity 
matrices and jA not only depend upon the modelling errors, but also 
upon the intensity matrix H of the original plant noise shown by 

eqs. t.49) and (51). Furthermore^ and (Jti are correlated according 

to eqs. (52) to (57). Thus, the guesswork on the part of the designer is 


minimized. 
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5. FURTHER SIMPLIFICATIONS IN PRACTICAL DESIGNS 

At first glance, the compensated Kalman filter might seem some- 
what complicated than that of the NMSSKBF alone. We remark that the 
complexity is directly related to the dimensionality of the two 
auxiliary vectors v(t) aind w{t) • However, in most cases of practical 
interest, canonical representations can be used to arrive at the 
smallest number of additional accumulators in the realization of the 
compensated Kalman filter. 


5.1 A Single Input Single Output Example 

To illustrate these implications consider the design 
of the compensated Kalman filter in the case of linear, time- 
invariant, stable single input single output plants. Suppose 
that the actual plant is characterized by its transfer function 


G(z) = 


n-1 n-2 

c z +c tZ +...+o^z + Ct 
n n~ 1 2 1 

n n-i 

z + a z +...+a_z + a- 
n 2 ± 


(82) 


Then there are at most 2n unknowns (the and in the plant 

description. 

Let a." and c. i=l, ... ,n. denote the nominal values of the a. 
in in 1 


and c^ , respectively. Then the standard controllable representation 


for the actual plant (equation (82)) is 
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u(t) + £(t) 


( 83 ) 


A 


z(t) 



+ e(t) 


( 84 ) 


and the nominal values of A , B , C are (in the same representation) 

— n “Ti 


0 


1 


0 


0 


0 


0 


1 0 


( 85 ) 


”*ln "®2n "^nn 


B = 
— n 



( 86 ) 


“ [C-I 

In 2n 


c 

nn 


] 


C 


( 87 ) 
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Thus 




0 

( (n-1) rows) 
6a' 


AB * 0 


Ac = 6c* 


where 


6c' 


'Vln' ^2-“2n' 


'= 2 -= 2 »' 


a -a 
n nn 


c -c 
n nn 


] 

] 


Examine the way the vector wCt). ia defined Cequation (.331). 
Since AB = 0, w(t) is given by 


w(t) * Aa x(t) 


0 _ 

6a'x(t) 


which means that eil though w(t) is an nxl vector, it really 
only one uncertain parameter, namely the scalar 


w^(t) = 6a'x(t) 


( 88 ) 

(89) 

(90) 

(91) 

(92) 

(93) 
contains 


(94) 
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v(t) in 

this case is also a scalar 



v(t) = ^’x(t) 

(95) 

Following then the procedures described in Section 4, 

one can see 

that the 

scalars w Ct) and v(.t). should be modelled as 
n 



w^(t+l) - Wjj(t) = Yjj(t) 

(96) 


v(t+l) - v(t) = X(t) 

(97) 

with 


E{Yj^(t)> = 0 

(98) 


E{X(t)} = 0 

(99) 

and 


K{Y^(t)Y„(T)) - 

(100) 


E{X(t)X(x)} = 

(101) 


E{y (t)X(T)} = fiy 

(102) 


E<1(«Y„(T)} = 

(103) 


E{i(tiX(T)) - 

(104) 
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Ideally, one selects 


r = 5a* 5 6a 

nn — 

A = 6c* 5 6c 






%Y 


n 


%x 


5a* ^ 
5 5c 


In practice, since 6^ and 6c^ are not known one should use their 
worst possible values in equations (105) -(109) to determine the 
covariances. 

Under these conditions, the equations of the compensated 
Kalman filter become (see equations (76) -(78)) 


x(t+l) - A x(t) + 


B U 
-HI— 


L r(t+l) 


0 




0 

w (t) 


w (t+1) = w^(t) +L r(t+l) 
n n wn 

v(t+l) = v(t) +L^r(t+1) 


(105) 

(106) 

(107) 

(108) 
(109) 


( 110 ) 

( 111 ) 


( 112 ) 
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with 

r(t) = z(t) - C x(.t|t-ll - v(±-l). (113) 

— < 1 — 

where 

a) is a constant nxl gain vector; 

b) L is a constant scalar gain: 

c) is a constant scalar gain. 

5.2 Extension to Multi-Input Multi-Output Systems 

The above procedures can be easily extended to the m\alti-input 
multi-output systems. We outline the step by step procediore that 
should be followed. 

Step 1 ; Examine the structiure of the nxn matrix M for arbitrairy 
variations of the actual and nominal plant parameters . Let p , 

O^^n, denote the nimber of non-zero rows of Aa . Define an nxp 
matrix according to the following r\ile. Let j=l,2, •••f P index 
the columns of P. 

(a) . Let i=l, j=l 

(b) . If the i-th row of ^ is nonzero^ set the j-th colvimn of P^ 

equal to e^ (the natural basis vector in R^) , set j=j+l, 
and go to (c) . if the i-th row of M is zero, go to (c) . 

(c) . If i=n stop; otherwise set i=i+l and go to (b) . 
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Example ; Suppose has the structure (where x denotes a nonzero 
element) 


AA == 


0 0 0 0 

0 X 0 X 

0 0 0 0 

X X X 0 


Then pp=2, and the 4x2 P matrix is given by 


0 0 
1 0 
0 0 
0 1 


Step 2; Examine the structure of the rxn matrix for arbitrary 
variations of the actual and nominal plant parameters. Let 
0^q<r^ denote the mrniber of non-zero rows of Ac . Define an rxq 
matrix according to the following rule. Let k=l,2,...,q index 
the columns of 2.® 

(a) . Let i=l, k=l 

(b) . If the i-th row of ^ is non-zero, set the k-th 

column of ^ equal to e_^ (the natural basic vector in 
R^) , set k=k+l, and go to • If the i-th row of Ac is 
zero, go to (c) . 
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Cc) - If i=r, stop; otherwise, set i=i+l and go to (b) . 


Exapple I Suppose that AC has the following structure 


Ac = 


X X 0 0 X 

0 Q 0 0 0 


0 0 0 0 0 


Then q=l and the matrix is given by 



Step 3 ; Let Wj^(t) e ^ ' such that 


2^(t+l) - Wj^(t) = Yj_(t) 

with 

E[Y3_(t)] » 0 
E[l^(t)X*(X)] 


(114) 


(115) 

(116) 


Make the identification 
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w(t) = £ 

(117) 



X^(t) = p'x(t) 

(118) 



£i = £'I £. 

(119) 

Step 

Ir 

Let v^(t) e A.i(*^ ^ such that 


with 


v(t+l) - v(t) = ^ 2 ^(t) 

(120) 



E[X^(t) ] = 0 

(121) 



Etx^(«x'(Tn 

(122) 

jyiake 

the 

identification 




v(t) = 2, Zi(^^ 

(123) 



Xj^(t) = 2'i(t) 

(124) 



= 2'A 2. 

(125) 

Step 

_Si 

Assume that ^(t) , 

pairwise correlated. 


E[£(t)Xi(T)] = ( 126 ) 

B[£(t)Xj^(T) ] = 

E[x^(«4(T)i-a,^^«„ 


(128) 
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Make the identification 



= ^ p 

(129) 


11 

(130) 


= r va 

(131) 


5.3 Reduced Dimension Compensated Kalman Filter; Summctry 
of Equations 

The following equations are obtained by siabstitution of 
equations (114) through (131) into (76) to (78) . 


Filter Equations 


X(t+l|tl = A xCt) + B u + P w ftl 
— ' — n~ — n— 1 

0.32a) 

x(t+l|t+l) = xCt+llt) + 

a32b) 

w. Ct+1) = w. Ct). + L , r, (t+1) 
—1 —1 -vrl— 1 

a33a) 

v^(t+l) = v^(t) + ^^r^Ct+ll 

a33b) 

r, Ct+1). = zCt+1) - C x(t+l|t) - Q V. ft) 

— 1 — X 

a34i 


Filter Gain Equations 

The filter gain matrices I^^Cnxr), I^^(pxrl, and I^^^(qxrl are given 
by 


i^l‘ 

5Vi 


“ 1 ^ ^ Si ^ 


-1 


■KlJ 


(135) 
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where Y is the unique (symmetric) positive definite solution of the 
(n+p+q)-th order algebraic matrix Riccati equation 




(136) 


M 2 respectively (n+p+q)x(n+p+q) , rx(n+p+q)r (n+p+q)x 

( n+p+q) constant matrices given by 


= 


P £ 

1 £ 

0 I 


(137) 


-2 



(C 0 

“T1 — 

2) 



— 

kr. 




h 





1 


(138) 


(139) 


5.4 Discussion 

The compensated KaJjnan filter equations presented in Section 5.3 
are the recommended ones for practical design. The additional 
workload associated with the computation of the jP and £ matrices is 
justified in terms of the simplification that results in specific 


problems 



-36- 


From a technical viewpoint the essential difference between 
the filters of Section 4.3 and 5.3 is that in the latter case the 
compensated Kalman filter can be shown to possess all the requisite 
controllability and observability conditions vdiich are necessary 
for the existence of a vinique positive definite solution to the al- 
gebraic matrix Riccati equation and the guaranteed stability of 
the resultant filter. It also pinpoints the additional nvariber 
Cp+q) of accumulators required to stabilize the uncompensated filter. 

The only "guesswork" required by the designer is the selection 
of the intensity matrices F_^(pxp) and (qxq) and the correlation 
covariance matrices ^ (nxp ) , (nxq) and , (pxq) . All 


WW w 

-Cy 




db A 


'1 ’"1 '1 
of them scale with the intensity matrix ^ of the plant noise ^(t)« 

This is evident from equations (49), (51), (53) -(55), (119), and 

(125) -(128), from which we obtain 


£l * =. 


“ 2'^ 

Or ~ ^ Aa'P 

^ \ = P'^ H ACQ 

^ 1 


(140) 

(141) 

(142) 

(143) 


( 144 ) 
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Since Z is assumed known, and P and are readily evaluated, the 
selection of F, , A , ^ i and fl , only involves the use 

of judicious estimates for ^ and ^ by the designer. As 
remarked before, these estimates can be usually found from a worst 
case analysis, i.e,, the worst probcdsle deviation of each parameter 
from its assumed nominal value. Of course, there is still an ele- 
ment of judicious judgement to be made ; at least in this design the 
"guesswork** can be related to the degree of worst deviation of the 
nominal plant from the actual one. 
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6. CONCLUSIONS 

A method for compensating the mismatched constant gain discrete time 
Kalman filter has been presented. The resultant compensated Kalman filter 
is time invariant, and the gains are all computed off-line, with some 
added complexity to the estimator. The compensation consists of the intro- 
duction of feed-forward accumulating (integrating) channels between the 
residual process and the uncompensated mismatched filter. 

The compensated Kalman filter has the property that bias errors in 
the state estimates are eliminated asymptotically. More complex algorithms 
have to be used if unbiased estimates are required for all t. 
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